AD-A210  247 


T 


rfc.  .*  ? 


» 


A 


lit  t nt  i 


i^a'i  ~ r  x»--  C--r 

d  ■  '  A.  -  .  -  N, 


The 


Architecture  of  Newton ,  a  General-Purpose 


Dynamic 


s 


Abstract 


Simulator 


James  F.  Cremer 
A.  James  Stewart 
Computer  Science  Department 
Cornell  University 


$ 


DTIC 

ELECTE 
JUL  1  4 1989 

D 


Thib  paper  describes  the  architecture  of  Sewton,  a  general- 
purpose  system  for  simulating  the  dynamics  of  complex 
physical  objects.  The  system  automatically  formulates 
and  analyzes  equations  of  motion,  and  performs  automatic 
modification  of  this  system  of  equations  when  necessitated 
by  changes  in  kinematic  relationships  between  objects.  Im¬ 
pact  and  temporary  contact  are  handled,  though  currently 
using  simple  models.  User-directed  influence  of  simula¬ 
tions  is  achieved  using  .Vetvton’s  control  module,  which  can 
he  used  to  experiment  with  the  control  of  many-degree-of- 
freedom  articulated  objects. 

1  Introduction 

This  paper  describes  the  architecture  of  Seaton,  a  general- 
purpose  model-driven  simulation  system.  Unlike  tradi¬ 
tional  simulation  systems,  which  concentrate  mainly  on  in¬ 
tegrating  an  unchanging  set  of  equations,  and  most  current 
CAD  systems,  which  concentrate  on  geometry  specification 
but  have  little  in  the  way  of  analysis  tools,  Seaton  was 
designed  to  provide  a  level  of  automatic  support  lhats  en¬ 
courage  the  kind  of  experimentation  necessary  for  success¬ 
ful  design.  By  using  a  model-based  object  representation 
and  fully  integrating  geometric  modeling  techniques,  it  was 
possible  to  incorporate  into  Seaton  a  general  mechanism 
to  deal  with  events  (called  exceptional  events)  that  cause 
•liscontinuities  in  object  behavior.  Thus,  Newton  can  auto¬ 
matically  and  incrementally  modify  its  internal  description 
of  mechanism  behavior  as  relationships  between  objects 
change  due  to  events  such  as  impacts,  contact  breakages,  or 
changes  in  control  algorthm  states.  Such  a  facility  greatly 
increases  the  power  and  flexibility  of  a  simulation  system. 

One  of  the  goals  of  the  Seaton  project  is  to  make  the 
design  cycle  more  efficient  by  integrating  design,  prototype 
implementation,  and  testing  in  a  single  system.  Attempts 
to  integrate  a  control  algorithm  and  a  particular  mechani¬ 
cal  system  can  expose  flaws  in  either  the  control  algorithm 
or  in  the  design  of  the  mechanical  system.  The  Seaton 
system  allows  immediate  redesign  and  testing  of  both  of 
these  components.  For  example,  a  designer  could  construct 
an  “electronic  prototype"  of  an  anthropomorphic  multi- 
fingered  robot  gripper  and  experiment  with  several  differ- 


Figure  l:  Different  H&nd  Configurations 


ent  configurations  before  committing  to  a  specific  design. 
Figure  1  shows  designs  modeled  after  the  Salisbury  hand. 
The  designer  might  first  choose  a  three-fingered  model  but 
be  unable  to  find  control  algorithms  that  achieve  design 
objectives.  With  minimal  effort  the  designer  could  test 
control  algorithms  on  a  four- fingered  model  to  determine 
whether  such  a  model  would  better  meet  specifications. 
Ease  of  redesign  facilitates  discovery  of  an  optimal  match 
between  control  algorithms  and  mechanical  design. 

Extensive  mechanical  engineering  research  has  led  to 
many  developments  in  physical  system  simulation.  The 
ADAMS  [2)  and  DADS  ($|  systems  are  examples  of  large 
state-of-the-art  systems  from  the  mechanical  engineering 
domain.  In  many  ways  such  systems  are  very  sophisti¬ 
cated:  efficient  formulations  of  mechanism  dynamics  are 
supported,  fancy  numerical  techniques  for  solving  equation 
systems  are  used,  object  flexibility  and  elasticity  are  often 
handled,  etc.  However,  from  a  computer  science  perspec¬ 
tive,  some  things  are  lacking.  Richer  object  representa¬ 
tions  are  needed.  Typically,  systems  have  almost  ignored 
geometric  considerations  and  represented  objects  simply 
as  point  masses  with  associated  inertias  and  coordinate 
systems.  Geometric  modeling  techniques  have  matured 
enough  to  allow  object  representations  used  by  dynamic 
simulations  to  include  a  complete  geometric  description 
usable  by  a  geometry  processing  module.  Furthermore. 
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Figure  3:  Redundant  Arm  Simulation 
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Figure  -I:  Newton's  top-level  loop 


lation  icene  as  execution  takes  place,  and  display  of  values 
of  any  quantities  that  the  user  wishes  to  monitor.  Typi¬ 
cally,  users  choose  to  display  the  evolution  of  values  of  a 
number  of  variables  using  a  set  of  graphs.  In  Figure  3, 
four  frames  from  a  simulation  of  a  redundant  robot  arm 
are  shown.  The  graphs  exhibit  values  of  the  position  and 
acceleration  of  the  arm's  end  effector,  and  joint  angles  and 
accelerations  for  the  distal  three  joints  of  the  arm.  The 
report  package  is  also  responsible  for  the  recording  of  in¬ 
formation  that  allows  later  redisplay  of  the  simulation  as 
a  real-time  “movie." 


2.3  Analysis  module 

Newton's  analysis  module  is  responsible  for  overall  coordi¬ 
nation  of  a  simulation.  After  defining  a  simulation  scenario 
using  the  definition  module,  the  main  simulation  loop  ex¬ 
ecutes  according  to  the  code  in  Figure  4. 

At  the  beginning  of  each  iteration,  the  current  state  of 
all  objects  is  saved  in  case  an  unacceptable  attempt  at 
stepping  forward  in  time  by  some  occurs  and  necessi- 
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tales  trying  again  with  a  smaller  time  increment.  Nru. 
the  integration  subsystem  is  invoked  in  order  to  produce 
new  positions  and  velocities  for  all  objects  from  thru 
old  positions,  velocities  and  accelerations.  The  call  to 
handle-except tonal-events  then  passes  control  to  ihe 
event-handling  subsystem,  which  is  responsible  for  detect¬ 
ing  and  handling  collisions,  contact  breakages,  control  al¬ 
gorithm  state  changes,  and  other  events  that  yield  discoit- 
tinuues  in  object  velocities  or  accelerations.  These  events 
can  invalidate  the  newly  proposed  state  and  necessitate 
restoration  of  the  previous  state,  integration  using  a  differ¬ 
ent  time  increment,  resolution  of  collisions  or  other  events, 
and  so  on.  The  event  handler  is  described  in  more  detad 
in  Section  4  and  in  [3|. 


3  Dynamic  Analysis 

Initially,  Newton- Euler  equations  of  motion  are  associated 
with  each  primitive  (i.e.  individual  rigid  body).'  At  the 
lime  an  object  is  created  the  equations  are  of  the  form 

me  —  0 

J w  -f  w  x  Jijj  —  0. 

A  specification  that  two  objects  are  to  be  con¬ 
nected  with  a  spherical  hinge  is  met  by  the  addition 
of  one  vectorial  constraint  equation  and  the  addition 
of  some  terms  to  the  motion  equations  of  the  con¬ 
strained  objects.  Thus,  acceleration  equations  become 


m,i>i 

J  |W|  +  W|  X  d|Ut| 

m,r, 

fjo)  f  gj  X  Jjwj 
f\  -t-Wl  XC|  VW|  x(ta#l  XC|  ) 


*1  x  Ik 

cl  x  “/e*« ye 
V  J  +WJ  X  CJ  +WJ  x(uljlCl) 


where  e,  is  the  vector  from  object  i’s  center  of  mass  to 
the  location  of  the  hinge  and  /*.«,,  is  the  constraint  force 
that  keeps  the  objects  together.  Other  kinds  of  hinges 
commonly  used  in  Newton  include  revolute  or  pin  joints, 
prismatic  joints,  springs  and  dampers,  and  rolling  contacts. 

If  gravity  is  to  be  accounted  for  during  the  simulation 
the  system  will  automatically  add  gravitational  force  terms 
(m,g)  to  the  objects’  translational  motion  equations.  The 
system  keeps  track  of  the  constraints  responsible  for  the 
various  terms  in  the  motion  equations.  Thus,  constraints, 
and  their  corresponding  motion  equation  terms,  can  be 
removed  at  any  time  without  necessitating  complete  ted- 
erivation  of  the  system  of  motion  equations. 

Using  this  method  of  dynamics  formulation,  closed-loop 
kinematic  chains  are  handled  as  simply  at  open  chains. 
Though  the  formulation  does  lead  to  large  sets  of  equa¬ 
tions,  the  matrices  generated  for  solving  for  accelerations 
and  constraint  forces  are  very  sparse  and  usually  symmet¬ 
ric.  Thus,  reasonable  efficiency  is  achieved  by  the  use  of 
sparse  matrix  techniques. 
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1  Newton  is  capable  of  using  dynamics  formulations  other  — — 
than  the  one  outlined  here.  Also,  some  preliminary  work  us-  feS 
inj  non-rigid  bodies  hat  been  done. 
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4.2  Contact 


;;;  The  at*te  Ku  been  saved  for  time  t. 

;;;  New  position*  and  velocities  have  been  proposed  for  time  t  +>  At 

1.  Compute  the  earliest  impact  time  tt  in  (t.t  +■  At|. 

2.  Integrate  from  time  t  to  produce  state  for  time  t,. 

3.  Deterrrune  and  analyze  aU  contacts. 

4.  WHILE  there  are  still  impacts  in  the  contact  set  DO 

4.1  Fo-muiate  equations  for  resolving  the  impacts. 

4.2  Solve  the  equations  to  obtain  new  velocities. 

Figure  5:  Impact  Resolution  Scheme 
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Figure  6:  Different  Collision  Interpretations 


of  a  set  of  impacts  then  often  produces  post-impact  veloc¬ 
ities  for  which  some  new  subset  of  the  contacts  represent 
impacts.  To  handle  this,  we  currently  iterate  the  proce¬ 
dure  until  the  set  of  contacts  contains  no  impacts.  Newton 
treats  this  entire  process  of  solving  a  sequence  of  instanta¬ 
neous  impacts  problems  as  occurring  instantaneously.  The 
impact  handling  scheme  is  summarised  in  Figure  5. 

We  use  this  impact  model  at  present  because  it  was  rela¬ 
tively  simple  to  implement  and  produces  expected  behavior 
in  many  cases.  For  instance,  in  Figure  6,  using  our  model 
to  resolve  the  collision  between  spheres  2  and  3  yields  the 
normally  expected  behavior  in  which,  after  impact,  spheres 
2  and  3  are  at  rest  and  sphere  1  moves  off  to  the  left.  Other 
impact  models  can  be  used  in  Newton.  Featherstone  [4|, 
for  example,  details  a  different  scheme  for  resolving  im¬ 
pacts  in  the  presence  of  contacts.  In  it,  impulses  are  trans¬ 
mitted  through  the  non-impact  contacts.  However,  under 
this  model,  the  spheres  of  the  example  behave  in  a  less  ex¬ 
pected  manner.  After  impact,  sphere  3  moves  back  to  the 
right  and  spheres  1  and  2  behave  as  if  they  were  connected 
by  a  true  hinge,  moving  off  to  the  left.  Still,  the  model 
does  produce  better  results  than  ours  in  other  cases,  such 
as  a  large  mass  block  falling  onto  a  smaller  maas  block  that 
is  resting  on  a  table  top.  It  is  clear  that  neither  model  is 
sophisticated  enough  to  do  realistic  impact  modeling.  We 
are  currently  investigating  more  complex  models  that  can 
better  account  for  the  elaaticity  properties  of  objects. 


Newton  was  designed  to  handle  continuous  contacts  be¬ 
tween  objects.  By  continuous  contacts  we  mean  coouacts 
in  which  two  objects  remain  in  contact  for  a  Unite  amount 
(not  infinitesimal,  as  for  impacts)  of  time.  Such  contact 
relationships  —  as  in  a  block  sliding  or  a  ball  rolling  on 
a  table  top — are  modeled  in  our  system  by  extensions  to 
hinges  called  temporary  hinges.  Temporary  hinges  gener¬ 
ally  represent  one-sided,  or  unilateral,  constraints. 

During  the  geometric  analysis  of  contacts,  normal- 
direction  velocities  of  contact  points  are  monitored.  When 
contact  velocities  are  xero},  there  is  continuous  contact  and 
the  system  creates  a  temporary  hinge  to  model  this  rela¬ 
tionship.  During  the  course  of  simulation,  the  system  con¬ 
tinually  monitors  contact  velocities,  removing  temporary 
hinges  when  the  contact  constraints  are  no  longer  met. 

Determination  of  object  accelerations  is  made  compli¬ 
cated  when  temporary  hinges  exist.  Constraint  equations 
for  temporary  hinges  are  formulated  in  the  same  manner 
as  for  other  hinges,  and  constraint  force  terms  are  again 
added  to  the  motion  equations  of  the  hinged  objects.  For 
instance,  for  point-on-plane  contact  without  friction  the 
instantaneous  acceleration  constraint  is 

(pi  -pi)  •  Dm.ui  +  2(pi  -  pi)  (ui  x  ncasis(|)  s=  0. 

However,  using  such  equality  constraints  when  solving  for 
object  accelerations  necessitates  checking  the  results  for 
consistency.  Since  the  equation  solving  procedure  calcu¬ 
lates  values  for  hinge  reaction  forces  in  addition  to  cal¬ 
culating  object  accelerations,  the  system  is  able  to  check 
that  the  values  of  the  reaction  forces  for  any  temporary 
hinges  are  consistent  with  that  hinge’s  intended  inequality 
constraint.  For  the  point-surface  contact  case  the  system 
needs  to  check  that  the  normal-direction  component  of  the 
reaction  force  is  not  tensile,  since  a  contact  hinge  should 
only  sustain  compression. 

■  For  two  polyhedral  objects  in  contact,  the  region  of  con¬ 
tact  will  be  either  a  polygon,  a  line  segment  or  a  point.  For 
the  case  of  a  polygonal  region,  it  is  sufficient  to  use  only 
vertices  of  the  polygon’s  convex  hull  in  formulating  the 
temporary  hinge  constraints.  The  system  first  assumes 
that  polygonal  support  will  be  maintained  and  searches 
for  a  '‘support  triangle”  among  the  convex  hull  vertices. 
If  no  support  triangle  produces  accelerations  and  reactioa 
forces  consistent  with  the  contact  conditions,  the  system 
successively  searches  for  supporting  contacts  having  more 
degrees  of  freedom,  i.e.  it  attempts  to  find  a  supporting 
line  segment  and,  failing  that,  a  single  support  point.  If  no 
set  of  contact  points  yield  consistent  solutions,  the  system 
will  remove  the  hinge.  In  the  simulation  of  Figure  7,  the 
kinematic  relationship  between  the  small  and  large  blocks 
changes  twice.  After  sliding  across  the  top  of  the  large 
block  and  maintaining  plane-plane  contact,  the  kinematic 
relationship  changes  to  plane-edge  contact  aa  the  small 
blocks  tips  over  the  end  of  the  block.  Ultimately,  it  breaks 
contact  altogether. 

1  Wilhin  some  epsilon,  of  course.  In  this  paper  we  avoid  the 
crucial  iscue  of  numerical  difficulties. 


impact,  contact,  and  friction  are  typically  handled  by  cur¬ 
rent  systems  in  an  ad  hoc  or  rudimentary  manner,  if  at 
all.  Ln  some  systems,  for  instance,  any  possible  impacts 
must  be  specified  ui  advance;  in  others,  a  Icind  of  "“force 
held”  technique  is  used,  in  which  between  every  pair  of 
objects  there  is  a  repelling  force  that  is  negligible  except 
when  objects  are  very  close  together. 

The  development  of  .Veur ton  was  also  influenced  by  the 
recent  work  by  graphics  and  animation  researchers  in  what 
they  term  physically-based  modeling  [1,101.  The  desire  to 
create  increasingly  complex  and  realistic  animations  has 
made  traditional  keyframing  techniques  less  successful  and 
led  to  interest  m  modeling  and  simulating  object  dynamics. 
While  the  techniques  currently  used  are  less  sophisticated 
than  those  used  in  mechanical  engineering,  the  emphasis 
placed  on  control  of  high-degree-of-Creedom  mechanisms, 
such  as  human  and  animal  models,  makes  the  research  in¬ 
teresting. 


2  Newton  Architecture 

Using  .Vetoton,  a  designer  can  define  complex  physical  ob¬ 
jects  and  mechanisms  and  can  represent  object  character¬ 
istics  from  a  wide  range  of  domains-  An  object  is  made 
up  of  a  number  of  “models,’’  each  responsible  for  organisa¬ 
tion  of  object  characteristics  from  a  particular  domain.  In 
most  simulations  the  basic  domains  of  geometry,  dynamics, 
and  controlled  behavior  are  modeled-  A  dynamic  model¬ 
ing  system,  for  example,  is  responsible  for  maintaining  an 
object’s  position,  velocity,  and  acceleration,  and  for  au¬ 
tomatically  formulating  the  object’s  dynamics  equations 
of  motion.  A  geometric  modeling  system  is  responsible 
for  information  about  an  object's  shape,  distinguished  fea¬ 
tures  on  the  object,  and  computation  of  geometric  integral 
properties  such  as  volume  and  moments  of  inertia.  It  must 
also  detect  and  analyse  object  inlerpeneiralions  so  that 
an  interference  modeling  system  can  deaf  with  collisions 
between  objects. 

With  this  kind  of  flexibility,  mechanism  design  and  anal¬ 
ysts  is  made  simpler;  a  number  of  simulations  of  a  physical 
system  might  be  carried  out,  with  different  sets  of  modeled 
properties  being  accounted  for  each  time.  New  modeled  as¬ 
pects  might  be  added  to  increase  the  overall  accuracy  of 
the  simulation,  or  certain  domains  might  be  abstracted  or 
ignored  to  allow  the  experimenter  to  focus  on  the  contri¬ 
bution  of  other  domains  to  the  observed  behavior. 

.Vewton  has  three  main  components;  the  definition  and 
representation  module,  the  analysis  module  and  the  report 
system.  The  definition  module  is  responsible  for  analysing 
high-level  language  descriptions  of  .Veurton  entities,  and  for 
organizing  information  in  the  appropriate  data  structures. 
The  analysis  component  implements  the  top-level  control 
loop  of  simulations  and  coordinates  the  working  of  various 
analysis  subsystems.  The  report  system  handles  genera¬ 
tion  of  graphical  feedback  to  users  during  simulations  as 
well  as  recording  of  relevant  information  for  later  regener¬ 
ation  of  animations. 


primitive  link(thickne*«,  height,  rho) 
properties:  (density:  rho); 

geometry*  cuboid  (thickness,  height,  thickness;  where 
begin 

topbtek:  (0,  height/2,  -thickneM/2), 
botback.  (0,  -height / 2,  -thickness/ 2), 
botoffmid:  (0,  -height/2  •  75*ihickness  .0) 
end 

primitive  belt  (radius,  rho) 
properties:  (density*  rho); 
geometry:  sphere  (radius) 

composite  pendulum( thickness,  linkheight,  rho) 
components 

10:  linkf  thickness,  thickness, rho), 

{1,12,13:  linkf thickness,  linkheight,  rho), 

ball:  bal((.7S  *  thickness,  rho); 

jlj2j3j4:  ball. and. socket 

structure 

join  10  to  11  with  jl  matching  (botback  topback), 
join  11  to  12  with  j2  matching  (botback  topback), 
join  12  to  13  with  j3  matching  (botback  topback  1; 
join  13  to  bail  with  matching  ^ootorfmid  center) 


Figure  2:  Pendulum  Definition 


2.1  Definition  module 

Newton's  definition  language  is  used  to  describe  a  variety 
of  simulation  entities,  including  objects,  hinges,  constraints, 
models,  equations  and  quantities.  Objects  are  further  di¬ 
vided  into  two  subclasses:  primitives,  corresponding  to  sin¬ 
gle  indivisible  bodies,  and  composites,  representing  collec¬ 
tions  of  objects  related  by  constraints.  The  constrained 
relationships  usually  correspond  to  material  hinges  such 
as  ball  and  socket  or  pin  joints  and  are  modeled  using  data 
structures  called  hinges.  The  components  of  composite  ob¬ 
jects  can  be  either  composites  or  primitives.  Thus,  descrip¬ 
tion  of  complex  mechanisms  is  made  simpler  by  breaking 
the  description  down  into  natural  part-component  relation¬ 
ships.  Figure  2  shows  the  definition  of  a  simple  five-object 
pendulum. 

One  advantage  of  the  hierarchical  object  representation 
scheme  is  that  it  facilitates  automatic,  incremental  refor¬ 
mulation  of  an  object’s  motion  equations.  During  sim¬ 
ulation,  Newton’s  analysis  module  makes  requests  for  an 
object’s  set  of  motion  equations.  The  set  is  constructed 
recursively,  by  requesting  the  equation  sets  for  each  of  the 
object’s  components  and  for  each  of  its  hinges.  At  ev¬ 
ery  level  of  an  object’s  composition  hierarchy,  the  set  of 
equations  for  that  level,  once  derived,  is  stored  in  the  ap¬ 
propriate  dynamic  model.  Then,  when  events  occur  that 
dictate  a  change  in  the  equations  for  a  component  of  an 
object,  only  the  equations  for  that  component  need  be 
rederived.  The  other  components'  equation  sets  are  still 
available  from  their  dynamic  models. 

2.2  Report  module 

As  stated  above,  the  report  system  is  responsible  for  gen¬ 
erating  output  that  can  be  of  use  to  the  experimenter  in 
analysing  simulations.  This  includes  display  of  the  simu- 


4  Event  handling 

During  the  course  of  interesting  simulations,  a  variety  of 
events  can  occur  that  require  special  processing.  Colli¬ 
sions  need  to  be  delected  and  resolved,  constraints  model¬ 
ing  contacts  between  objects  need  to  be  added  and  deleted, 
friction  forces  need  to  be  monitored  to  determine  when  an 
object  changes  from  sticking  to  sliding  on  a  surface,  and 
so  on.  In  general,  exceptional  events  can  cause  disconti¬ 
nuities  in  object  velocities  or  accelerations  and  necessitate 
corresponding  modification  of  the  internal  models  of  object 
benavior.  It  is  crucial  to  the  success  of  general-purpose 
simulation  systems  that  they  be  able  to  deal  with  such 
events. 

Atcivn  has  a  general-purpose  event  handier  that  is  cur¬ 
rently  responsible  for  coordinating  collision  detection  and 
resolution,  contact  maintainance,  and  handling  of  events 
corresponding  to  changes  in  control  program  states.  Since 
it  deals  with  discontinuous  changes  in  system  behavior,  the 
event  handlet  is  also  responsible  for  things  such  as  restart¬ 
ing  parts  of  the  integration  subsystem. 

For  the  purposes  of  the  paper,  we  restrict  the  following 
discussion  to  impacts  and  contacts  between  polyhedral  ob¬ 
jects.  though  the  .Veu/ton  system  is  not  restricted  in  this 
way.  We  then  describe  the  various  contacts  as  surface- 
surface.  edge-surface,  point-surface,  edge-edge,  and  so  on. 
Impacts  are  distinguished  from  other  contacts  as  those  con¬ 
tacts  where  the  velocity  of  a  contact  point  on  one  object 
relative  to  the  corresponding  point  on  the  second  object 
is  directed  into  the  second  object's  interior.  For  a  contact 
between  a  point,  pi,  of  an  object  01  and  a  cortesponding 
point,  pi,  on  the  surface  of  another  object  02,  the  condi¬ 
tion  is  staled  more  precisely  as  (pi  -pi)ntan 0,  where 
with  is  the  normal  to  the  contact  surface  (directed 

toward  02’s  exterior).  When  the  normal-direction  relative 
velocity  is  greater  than  zero,  the  contact  is  in  the  process 
of  breaking.  When  the  velocity  is  jero,  the  contact  will 
remain  and  may  result  in  creation  of  a  temporary  hinge. 

4.1  Impact 

When  the  event  handler  begins  its  impact  analysis,  the  in¬ 
tegration  module  has  just  proposed  a  set  of  positions  and 
velocities  for  tune,  t  ■*  At.  Ntvton  then  uses  its  geomet¬ 
ric  modeling  subsystem  to  determine  whether  any  impacts 
occurred  in  the  time  interval.  While  there  are  many  diffi¬ 
culties  in  properly  computing  the  intersection  between  two 
geometric  representations,  the  problem  of  determining  the 
precise  tune  of  any  impacts  makes  matters  still  more  com¬ 
plex.  To  do  things  correctly  the  four-dimensional  space¬ 
time  swept  volumes  of  two  objectj  must  be  intersected.  In 
the  current  implementation,  however,  we  count  on  time 
steps  being  sufficiently  small  that  we  don't  miss  collisions 
between  steps  and,  when  it  is  determined  that  an  unpact 
does  occur  between  times  t  and  t  +  At,  the  moment  of  im¬ 
pact  is  found  by  binary  search  of  the  tune  interval.  We 
repeatedly  halve  the  time  increment,  reintegrate,  and  an- 
alyie  contacts  for  the  new  time,  until  any  object  interpen- 
motions  are  within  a  user-controllable  tolerance. 


After  determining  the  time  of  any  impacts,  the  geomrtr, 
system  is  used  to  analyze  the  nature  of  ail  tnterobjei  t  .  on 
tacts  for  that  tune.  For  the  moment,  assume  that  all  sui  h 
contacts  are  indeed  impacts.  To  resolve  impacts,  Scxatun 
formulates  impulse-momentum  equations  for  each  object, 
and  contact-point  velocity  equations  for  each  impact  ( muig 
coefficients  of  restitution  based  on  object  properties),  and 
then  solves  this  equation  system  to  compute  instantaneous 
changes  for  the  object  velocities. 

The  equations  are  automatically  derived  in  a  fashion 
analogous  to  the  formulation  of  motion  equations  described 
earlier.  For  point-on-surface  impacts,  the  process  involves 
formulating  equations  of  the  following  form: 
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where  e,  is  the  vector  from  object  t’s  center  of  mass  to  the 
location  of  the  hinge,  is  the  (scalar)  impact  impulse. 

ntH,1Ci  is  the  surface  normal  at  the  point  of  impact,  A r, 
is  the  difference  between  object  t’s  center  of  mass  velocity 
before  and  after  impact,  p®  and  p*  are  the  velocities  of 
the  impact  point  on  object  t  before  and  after  impact,  re¬ 
spectively,  and  e  is  a  coefficient  of  restitution  that  depends 
on  the  material  properties  of  the  colliding  objects. 

When  composite  objects  are  involved,  impulses  due  to 
impacts  are  transmitted  through  hinges  by  formulaiuig  im¬ 
pact  constraint  equations  for  the  hinges  and  adding  appro¬ 
priate  impulse  terms  to  equations  for  the  hinged  objects. 

Thus,  if  object  2,  from  above,  and  a  third  object  are 
related  by  a  spherical  hinge,  the  hinge  equation  is 

rj  +  u/j  x  cj  =  r5  +  u»j  x  cj 
and  the  object  equations  are 
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where  is  a  global  coordinate  system  vector  repre¬ 

senting  the  impulse  transmitted  through  the  hinge. 

Our  current  model  of  Impact  is  extremely  simple  and 
clearly  not  satisfactory  in  some  situations.  When  all  of  the 
contacts  are  impacts,  use  of  this  collision  resolution  scheme 
yields  instantaneous  velocity  changes  that  do  not  imply  any 
further  impacts.  That  is,  after  the  impact  resolution  proce¬ 
dure  there  are  no  longer  any  contacts  that  meet  the  condi¬ 
tions  for  being  impacts,  la  many  situations,  however,  only 
a  subset  of  the  set  of  contacts  represent  true  impacts.  In 
dealing  with  such  situations,  our  model  does  not  produce 
impulses  for  the  non- impact  contacts.  Thus,  the  impact 
resolution  scheme  treats  these  contacts  as  if  there  were  an 
infinitesimal  separation  between  the  objects.  Resolution 
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Figure  7:  Changing  Kinematic  Relationships 


For  a  single  pair  of  object*  in  contact,  determination  of 
a  consistent  set  of  support  points  is  simple,  taking  time 
(at  worst)  linear  in  the  number  of  contact  vertices.  How¬ 
ever,  for  the  case  of  multiple  objects  and  contacts,  a  naive 
algorithm  postulates  support  sets  for  a  contact  indepen¬ 
dently  of  sets  proposed  for  other  contacts,  resulting  in  an 
exponential  search  of  the  space  of  possible  contact  sets. 
This  complexity  can  usually  be  avoided  by  using  heuris¬ 
tic*  during  the  search.  For  example,  since  kinematic  re¬ 
lationships  don’t  usually  change  very  often,  the  algorithm 
tirsi  attempts  to  use,  for  each  contact,  the  same  support 
points  as  for  the  previous  timestep.  Continuity  considera¬ 
tions  are  also  useful  in  most  cases;  the  contact  forces  and 
their  derivatives  can  be  monitored  to  determine  which  (and 
when)  contacts  break.  Methods  for  dealing  with  contact 
problems  are  examined  in  mote  detail  in  (4,8,5,31- 

4.3  Control 

Newton's  control  subsystem  permits  user-directed  influence 
of  object  motion  through  the  definition  of  control  force 
and  torque  quantities,  control  equations,  and  control  pro. 
grams  that  communicate  with  the  dynamic  analysis  system 
through  the  control  interface.  To  model  an  actuator  in  a 
hinge,  for  instance,  the  system  associates  a  control  torque 
quantity  with  the  hinge,  and,  as  part  of  the  creation  of  this 
quantity,  the  system  adds  torque  terms  to  motion  equa¬ 
tions  of  the  two  constrained  objects. 

Ln  Newton's  automatically-generated  equations  of  mo¬ 
tion  certain  quantities  are  considered  to  be  u  rum  own  i. 
Typically,  for  what  we  call  forward-dynamics  control,  the 
unknowns  consist  of  accelerations  and  joint  constraint 
forces,  while  positions,  velocities  and  joint  control  torques 
are  considered  to  be  known*.  On,  the  other  hand,  inverse 
dynamic  simulation  is  acheived  by  choosing  the  accelera¬ 
tions  as  knowns  and  solving  for  the  control  forces.  Com¬ 
bination  schemes  are  often  used  as  well;  given  an  object 
with  n  degrees  of  freedom,  with  motion  equations  contain¬ 
ing  q  acceleration  quantities  and  /  control  force  and  torque 
quantities,  a  control  algorithm  can  define  and  control  any 
n  of  the  +  /  quantities,  so  long  as  they  are  independent.  If 
fewer  than  n  quantities  are  controlled,  the  system  of  motion 
equations  is  uaderdetermined,  and  many  different  motions 


could  satisfy  the  constraints  of  the  control  algorithm.  Ln 
this  case  a  control  algorithm  can  guide  the  selection  of  a 
motion  by  providing  a  quadratic  cost  function  in  terms  of 
the  unknowns  of  the  system;  a  solution  is  then  chosen  that 
minimizes  this  cost  function. 

Newton  has  been  used  to  experiment  with  control  of 
many-degree-of- freedom  objects.  The  development  of  a 
high-level  algorithm  for  control  of  a  walking  figure  model 
is  presented  elsewhere  in  these  proceedings(9j. 


5  Summary 

Much  work  has  been  done  in  the  past  in  the  area  of  sim¬ 
ulation  of  dynamics,  much  of  it  by  mechanical  engineering 
researchers.  This  paper  has  described  the  architecture  of 
Newton,  a  dynamics  simulator  that  is  part  of  our  ongo- 
ing  project  of  applying  computer  science  principles  to  the 
development  of  more  powerful  and  flexible  simulation  sys¬ 
tems.  Newton  currently  supports  automatic  formulation 
and  modification  of  object  equations  of  .notion,  contains 
a  general-purpose  event- handling  mechanism,  allows  high 
level  description  of  simulated  objects  and  scenarios,  and 
supports  experimentation  with  control  of  high-degree-of- 
Creedom  mechanisms.  While  the  system  presently  handles 
impact,  contact  and  friction  problems  using  simple  mod¬ 
els,  more  sophisticated  models  can  be  incorporated  into 
Newton  without  the  need  for  major  system  revisions. 
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